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Coordination  Control  for  Haptic  and  Teleoperator  Systems* 


E.  Tatliciogiu,  M.  McIntyre,  D.  Dawson,  and  T.  Burg' 


Abstract:  In  this  paper,  two  controllers  are  developed 
for  nonlinear  haptic  and  teleoperator  systems  for  coordi¬ 
nation  of  the  master  and  slave  systems.  The  first  con¬ 
troller  is  proven  to  yield  a  semi-global  asymptotic  result 
in  the  presence  of  parametric  uncertainty  in  the  master 
and  the  slave  dynamic  models  provided  the  user  and  the 
environmental  input  forces  are  measurable.  The  second 
controller  yields  a  global  asymptotic  result  despite  un¬ 
measurable  user  and  environmental  input  forces  provided 
the  dynamic  models  of  the  master  and  slave  are  known. 
These  controllers  rely  on  a  transformation  and  a  flexible 
target  system  to  allow  the  master  system’s  impedance 
to  be  easily  adjusted  so  that  it  matches  a  desired  target 
system.  This  work  also  offers  a  structure  to  encode  a  ve¬ 
locity  field  assist  mechanism  to  provide  the  user  help  in 
controlling  the  slave  system  in  completing  a  pre-defined 
contour  following  task.  For  each  controller,  Lyapunov- 
based  techniques  are  used  to  prove  that  both  controllers 
provide  passive  coordination  of  the  haptic/teleoperator 
system  when  the  velocity  field  assist  mechanism  is  dis¬ 
abled.  When  the  velocity  field  assist  mechanism  is  en¬ 
abled,  the  analysis  proves  the  coordination  of  the  hap¬ 
tic/teleoperator  system.  Simulation  results  are  presented 
for  both  controllers. 

1  Introduction 

For  the  purposes  of  this  research,  the  following  definitions 
are  made.  A  teleoperator  system  enables  a  user  to  execute 
a  remote  task  with  an  output  system  (i.e.,  a  slave  system) 
operating  in  a  physical  environment  by  manipulating  an 
input  system  (i.e.,  a  joystick  or  a  master  system)  while 
providing  feedback  on  the  input  system.  A  haptic  system 
is  similar  to  a  teleoperator  system  with  the  exception  that 
the  slave  system  operates  in  a  virtual  environment.  Some 
common  application  areas  for  teleoperator  and  haptic  sys¬ 
tems  include  handling  hazardous  materials,  maneuvering 
mobile  robots,  underwater  vehicles,  and  microsurgery  in 
either  a  physical  or  a  virtual  environment.  The  opera¬ 
tor’s  ability  to  accurately  complete  these  tasks  is  affected 
by  the  transparency  of  the  teleoperator  or  haptic  sys¬ 
tem.  Tactile  and  force  feedback  from  the  system  con¬ 
troller  along  with  assistive  mechanisms  greatly  increase 
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the  user’s  performance  in  completing  the  desired  task  [8] . 
Tactile  and  force  feedback  provides  the  user  of  the  sys¬ 
tem  with  a  sense  of  feel  or  sense  of  telepresence  [32]  of 
what  the  slave  system  is  experiencing  in  either  a  physi¬ 
cal  or  a  virtual  environment.  Assistive  mechanisms  can 
be  integrated  into  the  system  controller  in  various  ways. 
One  example,  which  will  be  discussed  further  in  subse¬ 
quent  sections  of  this  paper,  is  the  encoding  of  a  tracking 
objective  in  the  master  system  that  assists  the  user  in 
completing  a  pre-defined  task  (i.e.,  consider  a  teleopera¬ 
tor  grinding  application  where  the  remote  user  controls 
the  slave  system  to  track  a  repeated  circular  path  to  com¬ 
plete  the  desired  task). 

Both  the  teleoperator  and/or  haptic  problem  are  theo¬ 
retically  challenging  due  to  issues  that  impact  the  user’s 
ability  to  impart  a  desired  motion  on  the  remote  envi¬ 
ronment  while  maintaining  a  sense  of  feel  through  the 
system  controller.  This  problem  is  further  complicated 
due  to  the  fact  that  master  system  apparent  inertia  is 
normally  very  different  than  that  of  the  slave  system  that 
is  operating  in  the  remote  environment,  be  it  physical  or 
virtual.  If  the  apparent  inertia  of  the  master  system  could 
be  adjusted  by  the  system  controller  to  appear  like  that 
of  the  slave  systems,  the  operator’s  sense  of  telepresence 
would  be  achieved,  hence,  increasing  the  user’s  ability  to 
operate  the  slave  system.  To  address  the  above  control 
objective,  commercially  available  haptic  systems  come  in 
two  distinct  classes:  impedance  controlled  devices,  and 
admittance  controlled  devices  [35] .  Both  classes  have  ad¬ 
vantages/disadvantages  depending  on  the  application,  see 

[8]  and  [35]  for  more  details. 

The  focus  of  some  of  the  previous  teleoperator  system 
research  has  been  to  achieve  ideal  transparency  between 
the  environment  and  the  user.  In  [10],  Hannaford  mod¬ 
eled  the  teleoperator  system  as  a  two-port  network  where 
an  estimate  of  the  impedance  of  the  slave  system  is  re¬ 
quired  to  achieve  transparency.  In  [6] ,  a  priori  knowledge 
of  the  environmental  inputs  to  the  slave  system  is  required 
to  achieve  the  transparency  control  objective.  Controllers 
aiming  at  low-frequency  transparency  were  suggested  in 

[9] ,  [14],  and  [31].  Frequency-based  control  designs  given 
in  [6],  [9],  [10],  [14],  and  [31]  are  for  linear  teleoperator  sys¬ 
tems.  The  concept  of  the  four-channel  architecture,  which 
assumes  knowledge  of  system  impedances  was  introduced 
by  the  authors  of  [14]  and  [37].  To  overcome  parametric 
uncertainties,  common  in  teleoperator  systems,  adaptive 
controllers  were  developed  in  [5],  [12],  [22],  [29],  [33],  and 
[38]. 

Other  research  has  focused  on  maintaining  safe  and  sta- 
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ble  operation  of  the  teleoperator  system  through  passiv¬ 
ity  concepts.  In  [1],  Anderson  and  Spong  transformed 
the  time  delay  problem  of  the  teleoperator  system  into  a 
transmission  line  problem  and  presented  a  controller  for 
the  communication  circuit  that  guarantees  passivity  of 
the  teleoperator  system  independent  of  time  delay  present 
in  the  communication  block.  In  [26],  Niemeyer  and  Slo- 
tine  extended  the  results  in  [1],  and  introduced  wave- 
variables  formulation  to  represent  transmission  delays, 
which  results  in  a  new  configuration  for  force-reflecting 
teleoperation.  These  results  were  then  extended  to  solve 
the  position  tracking  problem  where  [4]  and  [27]  provided 
a  solution  when  the  time  delay  is  constant  and  [3]  pro¬ 
vided  a  solution  when  the  time  delay  is  time-varying.  In 
[17],  a  passive  decomposition  for  linear  dynamically  sim¬ 
ilar  systems  is  introduced.  In  [15],  Lee  and  Li  extended 
these  results  to  define  a  nonlinear  decomposition  which 
achieves  passivity  of  the  master  and  the  slave  robots  by 
decomposing  the  closed-loop  teleoperator  system  into  two 
sub-systems.  The  reader  is  referred  to  [16],  [18],  and  [19] 
for  improvements  of  passive  decomposition.  In  [20]  and 
[21],  Lee  suggested  a  controller  for  a  master  and  multiple 
cooperative  slave  robots  over  a  communication  network  in 
the  presence  of  a  time  delay.  In  [11],  Hannaford  and  Ryu 
proposed  a  passivity  based  model-insensitive  approach 
that  measures  the  total  energy  of  the  system  and  damps 
excess  energy  by  injecting  a  variable  damping,  which  was 
then  extended  in  [30]. 

In  this  paper,  the  work  in  [25]  is  extended  so  that  it  is 
applicable  for  the  control  of  both  teleoperator  and  hap¬ 
tic  systems.  Two  controllers  are  developed  for  nonlin¬ 
ear  haptic  and  teleoperator  systems  that  target  coordi¬ 
nation  of  the  master  and  slave.  The  first  controller  is 
proven  to  yield  a  semi-global  asymptotic  result  in  the 
presence  of  parametric  uncertainty  in  the  master  and 
slave  dynamic  models  provided  the  user  and  environmen¬ 
tal  input  forces  are  measurable;  henceforth,  referred  to 
as  the  MIF,  (measurable  input  force)  controller.  The 
second  controller  yields  a  global  asymptotic  result  de¬ 
spite  unmeasurable  user  and  environmental  input  forces 
(UMIF)  provided  the  dynamic  models  of  the  master  and 
slave  systems  are  known.  This  paper  differs  from  [25], 
in  that  the  transformation  and  target  system  develop¬ 
ment  are  both  modified  to  allow  the  master  system’s  im¬ 
pedance,  felt  by  the  user,  to  be  adjusted  so  that  it  closely 
matches  that  of  a  desired  target  system  operating  in  a  re¬ 
mote  environment.  This  work  also  provides  the  encoding 
of  a  velocity  field  assist  mechanism  to  provide  the  user 
help  in  controlling  the  slave  system  in  completing  a  pre¬ 
defined  contour  following  task.  To  achieve  these  control 
objectives,  a  continuous  nonlinear  integral  feedback  con¬ 
troller/observer  (see  [28]  and  [36])  is  exploited  to  compen¬ 
sate  for  the  lack  of  master  and  slave  dynamics  informa¬ 
tion  or  user  and  environmental  force  measurements.  For 
each  controller,  Lyapunov-based  techniques  are  used  to 
prove  that  the  controller  development  implements  a  sta¬ 
ble  coordinated  haptic/teleoperator  system  with  the  op¬ 


tional  assist  mechanism  enabled.  When  this  mechanism 
is  disabled,  the  subsequent  analysis  proves  the  controller 
development  implements  a  stable  passively  coordinated 
haptic/teleoperator  system.  The  passivity  objective  is 
motivated  to  ensure  the  safety  of  the  user  and  the  en¬ 
vironment  when  in  contact  with  the  liaptic/teleoperator 
system.  Simulation  results  are  presented  for  proof  of  con¬ 
cept  for  both  controllers. 

2  System  Model 

The  mathematical  model  for  a  2n-DOF  nonlinear  hap¬ 
tic/teleoperator  system  consisting  of  a  revolute  n-DOF 
master  and  a  revolute  n-DOF  slave  system  are  assumed 
to  have  the  following  forms 

Ml  ( Xm )  Xm  +  Ni  (xm,  xm)  =T1+FH  (1) 
M2(xs)xs  +  N2(xs,xs)  =T2  +  Fe.  (2) 

In  (1)  and  (2),  xm  ( t ),  xm  ( t ),  xm  ( t )  £  Rn  denote  the 
task-space  position,  velocity,  and  acceleration  for  the 
master  system  and  xs  ( t ),  xs  ( t ),  xs  ( t )  denote  the  task- 
space  position,  velocity,  and  acceleration  for  the  slave  sys¬ 
tem,  M\  ( xm ),  M2  ( xs )  €  Rnxn  represent  the  inertia  ef¬ 
fects,  Ni  (xm,  xm),  N2  ( xs,xs )  £  R"  represent  other  dy¬ 
namic  effects,  Ti  (f),  T2  (t)  €  Kn  represent  the  control  in¬ 
put  vectors,  Fh  ( t )  £  R"  represents  the  user  input  force, 
and  Fe  (t)  £  R"  represents  the  input  force  from  the  phys¬ 
ical  or  virtual  environment.  End-effector  positions  xrn  ( t ) 
and  xs  ( t )  can  be  decomposed  as  follows 


where  xmp  ( t ) ,  xsp  ( t )  £  Rp  represent  position  vectors  and 
xmr  ( t ) ,  xsr  (t)  £  Rr  represent  orientation  angle  vectors, 
where  the  integers  p  and  r  satisfy  p  +  r  =  n.  The  subse¬ 
quent  development  utilizes  the  property  that  the  master 
and  slave  inertia  matrices  are  positive  definite,  symmetric 
and  satisfies  the  following  inequalities  [23] 

mu  ||£||2  —  Mi  (•)  £  <  m2i  ||£||2  (3) 

V£  £  R"  and  i  =  1,2  where  mu,  m2i  £  R  are  positive  con¬ 
stants,  and  ||-||  denotes  the  Euclidean  norm.  To  achieve 
the  control  objectives,  the  subsequent  development  is  de¬ 
rived  based  on  the  assumption  that  xm  (i),  xs  (f),  xm  ( t ), 
xa  ( t )  are  measurable,  and  Mt  (•),  Ni  (•)  are  second  order 
differentiable  for  i—  1,2. 

Assumption  1  The  user  input  force  and  the  environ¬ 
mental  force  along  with  their  first  and  second  time 
derivatives,  FH  (t),  FH  (f),  FH  (t),  FE  (f),  FE  ( t ),  and 
Fe  (t)  are  bounded  (see  [15]  and  [17]  for  the  prece¬ 
dence  of  this  type  of  assumption). 

3  MIF  Control  Development 

For  the  MIF  controller  development,  the  following  analy¬ 
sis  will  prove  a  semi-global  asymptotic  result  despite  para- 
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metric  uncertainty  in  the  master  and  slave  system  dy¬ 
namic  models  provided  the  user  and  the  physical  or  vir¬ 
tual  environmental  input  forces  are  measurable.  It  should 
be  noted  that  for  many  types  of  virtual  slave  systems, 
the  dynamic  model  of  the  virtual  slave  is  known  a  pri¬ 
ori]  however;  unstructured  uncertainties  in  the  dynamic 
model  are  common  for  teleoperator  slave  systems. 

3.1  Control  Objective  and  Model  Trans¬ 
formation 

A  control  objective  for  haptic  and  teleoperator  systems 
is  to  ensure  the  coordination  between  the  master  and  the 
slave  systems  and  to  meet  the  tracking  objective  in  the 
following  sense 

xs  (t)  — ►  xm  (t)  as  t  — ►  oo  (4) 

xm  {t)  — ►  (f)  as  t  — ►  oo  (5) 


The  subsequent  development  utilizes  the  property  that 
M  (. x )  is  positive  definite,  symmetric  and  satisfies  the  fol¬ 
lowing  inequalities  [23] 

fhi  ||£||2  <  fM  (x)£  <  m2  ||C||2  (14) 

£  R2™  where  mi,  m2  £  R  are  positive  constants.  By 
utilizing  the  assumption  that  Mi  (•),  N-i  (•)  are  second  or¬ 
der  differentiable  for  i  =  1,2,  it  is  clear  that  M  (•)  and 
N  (•)  are  also  second  order  differentiable. 

To  facilitate  the  development  of  the  error  system,  the 
filtered  tracking  error  signal,  denoted  by  r  (t)  £  R2",  is 
defined  as  follows 

r  =  e  2  +  a\e2  (15) 

where  e2  (t)  £  R2"  is  defined  as  follows 

e2  =  e1  +  a-2e1  (16) 


where  (t)  £  R"  is  a  subsequently  designed  desired  tra¬ 
jectory.  Another  sub-control  objective  is  to  guarantee 
that  the  closed-loop  system  remains  passive  with  respect 
to  the  user  and  the  physical/virtual  environmental  power 
in  the  following  sense  [15] 

[  (*m  (T)  Fh  (t)  +  xTs  (r)  Fe  (t))  dr  >  -c{  (6) 

Jto 

where  c\  £  R  is  a  bounding  constant.  The  passivity  objec¬ 
tive  is  motivated  to  ensure  the  safety  of  the  user  and  the 
physical  environment  [15].  The  final  objective  is  that  all 
signals  are  required  to  remain  bounded  within  the  closed- 
loop  system.  It  should  be  noted  that,  the  passivity  ob¬ 
jective  is  not  met  when  the  subsequently  presented  user 
assist  mechanism  is  enabled. 

To  facilitate  the  subsequent  development,  an  invertible 
transformation  is  defined  that  encodes  the  control  objec¬ 
tives  as  follows 

x~s[xm  } T  (7) 

where  x  (t)  £  R2"  and  S  £  R2nx2n  is  defined  as  follows 


S  = 


In 

In 


KJnxn 

~In 


(8) 


where  In  £  R"xn  denotes  the  identity  matrix,  Onxn  £ 
R”x"  denotes  a  matrix  of  zeros,  and  it  is  noted  that 
S'”1  =  S.  After  utilizing  the  transformation  defined  in 
(7),  the  dynamic  models  of  the  haptic/teleoperator  sys¬ 
tems  given  in  (1)  and  (2)  can  be  combined  as  follows 


Mx  +  N  =  T  +  F  (9) 


where  N  (x,x),  T  (t ),  F(t)  £  R2"  and  M  (x)  £  R2nx2n 
are  defined  as  follows 


M  = 
N  4 

rp  A_ 

F  4 


S~T 

S~T 

S~T 

S~T 


Mi  0  nxn 

Qnxn  M2 

[  N?  NJ  ]T 

[  n  n  ]T 

[FTh  F?]T. 


S”1 


(10) 

(11) 

(12) 

(13) 


where  oq,  a2  £  R  are  positive  control  gains,  and  e\  (t)  £ 
R2"  is  defined  as  follows 


ei  =  Xd-x.  (17) 

The  error  signal  e\  (t)  can  be  decomposed  as  follows 

ei  =  [  f'i'i  c'vi  }T  (18) 

where  en  (t)  £  R"  represents  the  master  system  tracking 
error,  and  ei2  (t)  £  R"  represents  the  coordination  error. 
In  (17),  Xd(t)  £  R2n  is  defined  as  follows 

xd=[ed  0^  ]T  (19) 

where  On  £  R"  denotes  a  vector  of  zeros.  Based  on  the 
definition  of  x  (t)  in  (7)  and  e\  ( t )  in  (17),  it  is  clear  that 
if  || eq  (t)||  — ►  0  then  xs  (t)  xm  (t)  and  xm  (t)  — >  £d  ( t ) . 

The  desired  trajectory  £d  (t)  introduced  in  (5)  is  gener¬ 
ated  by  the  following  second-order  coupled  dynamic  tar¬ 
get  system 

Orf  +  Vd  (20) 


Mrfld  +  Brild  +  KT\ d  =  F  (21) 

where  i) d(t)  £  R"  is  an  auxiliary  filter  signal,  Mt,  Bt, 
Kt  £  R"xn  are  constant  positive  definite,  diagonal  matri¬ 
ces,  ip  (•)  £  Rp  is  a  velocity  field  function  [24]  that  encodes 
the  user  assist  mechanism,  0r  £  Rr  denotes  a  vector  of 
zeros,  7  is  a  constant  gain  that  is  either  0  or  1.  It  should 
be  noted  that,  when  7  =  0,  the  user  assist  mechanism  is 
disabled,  and  when  7=1,  then  the  user  assist  mechanism 
is  enabled.  In  (21),  F  (t)  £  R"  is  defined  as  follows 

F±FH  +  FE.  (22) 


Also,  in  (21)  the  term  \d  (t)  £  R"  is  defined  as  follows 


Ad  =  dd  -  7 


f  FT  (£p  (r))  dr 


L  to 


(23) 
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where  (t)  is  generated  by  the  differential  equation  of 
(20),  and  can  be  decomposed  as  follows 

nd±[eP  (24) 

where  (p  (t)  £  represents  a  position  vector,  and 
(t)  £  W  represents  an  orientation  angle  vector. 

Remark  1  Velocity  fields  have  been  utilized  in  previous 
control  literature,  see  [2]  and  [24]  for  their  definition  and 
application.  The  velocity  field  function  in  (20)  is  inte¬ 
grated  to  assist  the  user  in  executing  a  remote  task  (i.e., 
tracking  a  circular  contour).  It  is  assumed  that  the  ve¬ 
locity  field  function  is  designed  such  that  ip  (•),  ip  (•),  ip  (•) 
and  'ip  (•)  are  bounded  provided  that  their  arguments  are 
bounded. 

Remark  2  The  velocity  field  function  p  (•)  is  assumed 
to  be  designed  such  that,  from  (20),  ifrjd(t)  £  £oo  then 
fd(t),  €d(t)  e  -Coq.  Based  on  this  assumption  and  the 
analysis  in  Appendix  A,  it  is  easy  to  show  that  all  sig¬ 
nals  in  dynamic  target  system  given  in  (20)  and  (21)  are 
bounded,  and  that  the  higher  order  derivatives  are  also 
bounded. 

Remark  3  It  should  be  noted  that,  when  the  user  assist 
mechanism  is  disabled,  (i.e.,  7  =  0)  the  target  system 
defined  by  (20)  and  (21),  becomes  a  standard  impedance 
model  as  follows 

Mrid  +  Md  +  KTfd  =  F-  (25) 

3.2  Closed-Loop  Error  System 

Based  on  the  assumption  that  the  user  forces  FH  (t) , 
and  the  physical/virtual  environmental  forces  Fe  (t) ,  are 
measurable,  the  control  input  T  (t)  of  (9)  is  designed  as 
follows 

T  =  u  —  F  (26) 

where  u  (t)  £  K2n  is  a  subsequently  designed  auxiliary 
control  input.  Substituting  (26)  into  (9)  results  in  the 
following  simplified  dynamic  system 

Mx  +  N  =  u.  (27) 

After  taking  the  time  derivative  of  (15)  and  premultiply¬ 
ing  by  M  (x),  the  following  expression  can  be  derived 

Mr  =  M  xd  +  Mx  +  N  —  u  +a2Mei  +  a\Me 2  (28) 

where  (16),  (17),  and  the  time  derivative  of  (27)  were  uti¬ 
lized.  To  facilitate  the  subsequent  analysis,  the  expression 
in  (28)  can  be  arranged  as  follows 

Mr  =  N  +  Nd  —  e2—  u  —  -  M  r  (29) 


where  N  (x,  x,  x,  t)  £  M2"  is  defined  as  follows 

N  =  N  -  Nd  (30) 

where  N  (x,  x,  x,  t)  £  M2”  is  defined  as  follows 

N  =  Mxd  +  Mx  +  a2Mei  (31) 

+aiMe2  +  e2+  N  +-  M  r 

and  Nd  ( t )  £  M2”  is  defined  as  follows 

Nd  =  N\x=Xd,  x=xd,  x=xd  (32) 

=  M  (xd)  xd  +  M  (xd,  Xd)  xd+  N  (xd,  id,  xd ) . 
Remark  4  After  utilizing  (19),  (32)  and  the  fact  that  we 


show  in  Appendix  A,  then 
upper  bounded  as  follows 

||Ad(t)||  and  Nd(t) 

can  be 

||  Ad  (t)  ||  <?i 

Nd  ( t )  <  <;2 

(33) 

where  <;i,  <?2  €  K.  are  known  positive  constants. 


To  achieve  the  stated  control  objectives,  the  auxiliary 
control  input  u,  (t)  introduced  in  (26)  is  designed  as  follows 

u  =  (ka  +  l)  e2  (t)  —  e2  (to)  +  t*i  [  e2(T)dT 

Jt0 

+  (Pi  +  P2)  [  sgn  (e2  (r))  dr  (34) 

Jt  0 

where  ks,  j31,  e  ®  are  positive  control  gains,  and 
sgn  (•)  denotes  the  vector  signum  function.  The  term 
e2  (to)  in  (34)  is  used  to  ensure  that  u  (to)  =  0 2n  where 
02n  €  K.2n  denotes  a  vector  of  zeros.  The  time  derivative 
of  (34)  is  obtained  as  follows 

u=  (ks  +  1)  r  +  (fix  +  fi2)  sgn  (e2)  (35) 

where  (15)  was  utilized.  Substituting  (35)  into  (29)  re¬ 
sults  in  the  following  closed-loop  error  system 

Mr  =  ~(ks  +  1)  r  -  (/31  +  02)  sgn  (e2)  (36) 

+1 V  +  Nd  -  e2  -  ^  M  r. 

3.3  Stability  Analysis 

Theorem  1  The  controller  given  in  (26)  and  (34)  guar¬ 
antees  that  all  the  system  signals  are  bounded  under  the 
closed-loop  operation  and  that  coordination  between  the 
master  and  the  slave  systems,  and  the  tracking  objective 
are  met  in  the  sense  that 

xs  (t)  — ►  xm  (t)  as  t  — ►  00  (37) 

xm(t)  £d(t)  as  t.  — ►  00  (38) 


provided  the  control  gain  j3x  introduced  in  (34)  is  selected 
to  satisfy  the  following  sufficient  condition 

Pi  >  Cl  +  —C2  (39) 

ai 

where  <Ti  and  were  introduced  in  (33),  the  control  gains 
ai  and  a 2  are  selected  greater  than  2,  and  ks  is  selected 
sufficiently  large  relative  to  the  system’s  initial  conditions. 

Proof.  See  Appendix  B. 

Theorem  2  The  controller  given  in  (26)  and  (34)  guar¬ 
antees  the  closed-loop  system  is  passive  with  respect  to  the 
user  and  the  physical/virtual  environmental  power  when 
the  user  assist  mechanism  is  disabled  (i.e.,  7  =  0/ 

Proof.  See  Appendix  C. 

4  UMIF  Control  Development 

For  the  UMIF  controller  development,  the  following 
analysis  will  prove  a  global  asymptotic  result  despite  un¬ 
measurable  user  and  environmental  input  forces  provided 
the  dynamic  models  of  the  master  and  slave  systems  are 
known.  Assumption  1  is  also  utilized  for  the  subsequent 
development.  It  should  be  noted  that,  for  many  types 
of  virtual  slave  systems,  the  virtual  environmental  forces 
are  measurable;  however,  the  user  input  force  may  not  be 
measurable. 

4.1  Control  Objective  and  Model  Trans¬ 
formation 

A  control  objective  for  haptic  and  teleoperator  systems 
is  to  guarantee  coordination  between  the  master  and  the 
slave  systems  and  to  meet  the  tracking  objective  in  the 
following  sense 

xs  ( t )  — *  xm  ( t )  as  t  — ►  00  (40) 

Xm  (t)  ^  (t)  as  t  — ►  00  (41) 

where  <*7  (t)  6  is  a  subsequently  designed  desired  tra¬ 
jectory.  Another  sub-control  objective  is  to  guarantee 
that  the  system  remains  passive  with  respect  to  the  user 
and  the  environmental  power  as  in  (6).  It  should  be  noted 
that  the  passivity  objective  is  not  met  when  the  user  as¬ 
sist  mechanism  is  enabled.  The  final  objective  is  that  all 
signals  are  required  to  remain  bounded  within  the  closed- 
loop  system. 

To  facilitate  the  subsequent  development,  an  invertible 
transformation  is  defined  that  encodes  the  control  objec¬ 
tives  as  follows 

x  =  S  \  Xm  1  +  f  5"  I  (42) 

.  %s  \  [  £2  v  ' 

where  x  (f)  £  R2"  and  ( 2  (t)  €  Kn  is  a  subsequently  de¬ 
fined  desired  trajectory,  and  S  £  R2rtx2r»  was  defined  in 


(8).  After  utilizing  the  transformation  defined  in  (42),  the 
dynamic  models  of  the  haptic/teleoperator  system  given 
in  (1)  and  (2)  can  be  combined  as  follows 

Mx  -  M  +  N  =  T  +  F  (43) 

£2 

where  M  (x),  N(x,x),  T  (t ),  and  F  (t)  were  defined  in 
(10)-(13). 

The  filtered  tracking  error  signal  denoted  by  r  (f )  £  R2" 
is  defined  as  follows 

r  =  e  2  +  e2  (44) 

where  e2  (t)  £  R2"  is  defined  as  follows 

e2  =  M  (ei  +  aei)  (45) 

where  a  £  R  is  a  positive  control  gain,  and  e\  (t)  £  R2” 
is  defined  as  follows 

ei  =  -  x  (46) 

where  ( t )  is  a  subsequently  defined  desired  trajectory. 

The  error  signal  ei  (t)  can  be  decomposed  as  follows 

ei  —  [  eii  ei2  ]T  (47) 

where  e\\  (t)  £  R"  represents  the  master  system  tracking 
error,  and  ei2  (t)  £  R"  represents  the  coordination  error. 

To  compensate  for  the  unmeasurable  user  and  phys¬ 
ical/virtual  environmental  forces,  a  nonlinear  force  ob¬ 
server  is  designed  subsequently.  This  nonlinear  observer 
is  utilized  in  driving  the  target  system,  thus  requiring  a 
2n-dimensional  system.  As  a  result  of  this  fact,  the  de¬ 
sired  trajectory,  defined  as  (t)  £  R2",  is  generated  by 
the  following  second  order  coupled  dynamic  target  sys¬ 
tem1 

L  =  l[vT(Zip)  0f]T+Vd  (48) 

MTr)d  +  BxPd  +  AjAd  =  F  (49) 

where  r/d  ( t )  £  R2n  is  an  auxiliary  filter  signal,  M  ( x )  was 
defined  in  (10),  Mt ,  Bt  and  AT  £  K2nx2n  represent 
constant,  positive  definite,  diagonal  matrices,  F(t)  £  R2" 
is  a  subsequently  designed  nonlinear  observer,  ip  (•)  £  Rp 
was  introduced  in  Section  3.1,  0S  £  Rs  denotes  a  vector 
of  zeros  where  s  +  p  =  2 n,  and  7  is  a  constant  gain  that 
is  either  0  or  1.  It  should  be  noted  that,  when  7  =  0,  the 
user  assist  mechanism  is  disabled,  and  when  7=1,  then 
the  user  assist  mechanism  is  enabled.  In  (49),  the  term 
Xd  (t)  £  R2"  is  defined  as  follows 

T  *  1T 

^d  =  fd-l  j>T  (£lp  (r))  dr  Of  (50) 

-  t0 

1For  the  existence  of  see  Appendix  G. 
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where  £d  (t)  =  [  ]T  is  generated  by  the  differ¬ 

ential  equation  given  in  (48)  where  fi(t),  £2  (f)  e  R"- 
The  desired  trajectory  for  the  master  system  denoted  by 
£-[  (t),  can  be  decomposed  as  follows 

&]T  (51) 

where  flp  (t)  £  represents  a  position  vector,  and 
£lr  (t)  £  represents  an  orientation  angle  vector. 

Remark  5  The  velocity  field  function  ip  (•)  is  assumed 
to  be  designed  such  that,  from  (48),  ifrjd(t)  £  Coo  then 
£d(t),  £d(t)  £  Coo  ■  Subsequent  analysis  will  prove  that 
F  (t)  £  Coo  ■  After  utilizing  these  facts  along  with  (14),  the 
analysis  in  Appendix  F  proves  that  all  signals  in  the  dy¬ 
namic  target  system  given  in  (48)  and  (49)  are  bounded. 

Remark  6  Although  the  desired  trajectory  dynamics  de¬ 
fined  in  (48)  and  (49)  generated  a  2n- dimensional  sig¬ 
nal,  it  should  be  noted  that  the  master  system  tracks  an 
n-dimensional  signal,  denoted  as  £  1  ( t ).  The  use  of  a  2 n- 
dimensional  desired  trajectory  generator  is  a  consequence 
of  the  fact  that  both  the  user  input  force  and  the  phys¬ 
ical/virtual  environmental  force  are  unmeasurable,  and 
hence,  a  2n- dimensional  nonlinear  force  observer  must 
be  utilized  to  drive  the  target  system  as  defined  in  (49). 
From  the  definition  of  the  transformation  and  the  error 
signal  e\  ( t )  (see  (42)  and  (46)),  it  is  clear  that  additional 
set  of  desired  trajectory  dynamics,  denoted  by  ( t ),  are 
eliminated  in  the  error  system  development. 

Remark  7  It  should  be  noted  that,  when  the  user  assist 
mechanism  is  disabled  (i.e.,  7  =  0),  then  the  target  system 
defined  by  (48)  and  (49),  becomes  an  impedance  model 
described  as  follows 

MtU  +  BTfd  +  KTfd  =  (MMfi1) -1  F.  (52) 

4.2  Closed-Loop  Error  System 

To  develop  the  closed-loop  error  system  for  r  (t) ,  error 
system  dynamics  for  e\  (t)  and  e 2  (t)  are  derived  first.  Af¬ 
ter  taking  the  second  time  derivative  of  (46)  and  premul¬ 
tiplying  by  M  (x),  the  following  expression  can  be  derived 

Me  1  =  F  —  (MJlfj,1)  (BTrjd  +  KTXd)  (53) 

—M  °:n  +N-T-F 
s2 

+iMj(([VTfcP)  «nT) 

where  (43),  (48)  and  (49)  were  utilized.  Based  on  the 
assumption  of  exact  model  knowledge,  the  control  input 
T(t)  is  designed  as  follows 

f  4  T1-(MMf1)(BTrid  +  KTXd)-M 

+N  +  lMjt([  pT(flp)  0J]T)  (54) 


where  T\  (t)  £  K2"  is  a  subsequently  designed  auxiliary 
control  input.  Substituting  (54)  into  (53)  results  in  the 
following  simplified  expression 

Me\  =  F  —  F  —  T\.  (55) 

The  time  derivative  of  (t)  in  (45)  can  be  obtained  as 
follows 

e-2  =M  e\  +  a  M  ei  +  aMe\  +  F  —  F  —  f)  (56) 

where  (55)  was  utilized.  Based  on  (56),  the  auxiliary 
control  input  7\(t)  is  designed  as  follows 

Tj  =M  e\  +  a  Me  1  +  aMe  1.  (57) 

After  substituting  (57)  into  (56),  the  following  simplified 
expression  is  obtained 

e2=F-F.  (58) 

Taking  the  time  derivative  of  (58)  results  in  the  following 
expression 

e2  =F  —  F  .  (59) 

The  error  system  dynamics  for  r  (ft)  can  be  derived  by 
taking  the  time  derivative  of  (44) 

r  —  r  —  e2+  F  —  F  (60) 

where  (44)  and  (59)  were  both  utilized.  To  achieve  the 
stated  control  objectives,  the  proportional-integral  like 
nonlinear  observer  F(t)  introduced  in  (49)  is  designed  as 
follows 

F  =  ~(ks  +  1)  e2  (t)  -  e2  (t0)  +  [  e2  (r)  dr 

Jt0 

-  (Pi  +P2)  [  sgn(e2  (r))dr  (61) 

J  to 

where  ks,  01,  and  /32  €  M  are  positive  control  gains.  The 
term  e2  (to)  is  used  to  ensure  that  F  (to)  =  O2 The  time 
derivative  of  (61)  is  obtained  as  follows 

F=  -  (ks  +  1)  r  -  (f31  +  fi2)  sgn  (e2)  (62) 

where  (44)  was  utilized.  Substituting  (62)  into  (60)  re¬ 
sults  in  the  following  closed-loop  error  system 

r  =  —e2—  F  —ksr  -  (j3l  +  (32)  sgn  (e2) .  (63) 

Remark  8  After  utilizing  (13)  and  Assumption  1,  then 
F  (t)  and  F  (t)  can  be  upper  bounded  as  follows 

F  (t)  <g3  F  (t)  <  ?4  (64) 

where  q,  q  e  M  denote  positive  bounding  constants. 
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4.3  Stability  Analysis 

Theorem  3  The  controller  given  in  (54)  and  (57)  guar¬ 
antees  that  all  signals  are  bounded  under  closed-loop  op¬ 
eration  and  that  coordination  between  the  muster  and  the 
slave  systems,  arid  the  tracking  objective  are  met  in  the 
sense  that 

xs  ( t )  — ►  xm  ( t )  as  t  —i  oo  (65) 

xm  (t)  — >  Ci  (i)  as  t  — * y  oo  (66) 

provided  the  control  gain  /31,  introduced  in  (61)  is  selected 
to  satisfy  the  sufficient  condition 

01  >  ?3  +  ?4,  (67) 

where  <;3  and  ?4  were  introduced  in  (64)- 

Proof.  See  Appendix  D. 

Theorem  4  The  controller  given  in  (54)  and  (57)  guar¬ 
antees  that  the  haptic/teleoperator  system  is  passive  with 
respect  to  the  user  and  the  physical/virtual  environmen¬ 
tal  power  when  the  user  assist  mechanism  is  disabled  (i.e., 

7  =  0;. 

Proof.  See  Appendix  E. 

5  Conclusions 

Two  controllers  were  developed  for  nonlinear  haptic  and 
teleoperator  systems  that  target  coordination  of  the  mas¬ 
ter  and  slave.  The  first  controller  was  proven  to  yield 
a  semi-global  asymptotic  result  in  the  presence  of  para¬ 
metric  uncertainty  in  the  master  and  slave  dynamic  mod¬ 
els  provided  the  user  and  environmental  input  forces  are 
measurable.  The  second  controller  was  proven  to  yield  a 
global  asymptotic  result  despite  unmeasurable  user  and 
environmental  input  forces  provided  the  dynamic  mod¬ 
els  of  the  master  and  slave  are  known.  A  transforma-  [10] 
tion  along  with  an  adjustable  target  system  were  uti¬ 
lized  that  allows  the  master  system’s  impedance  to  be 
adjusted  so  that  matches  a  desired  target  system  operat¬ 
ing  in  a  remote  physical/virtual  environment.  This  work 
also  presented  an  optional  strategy  to  encode  a  velocity 
field  assist  mechanism  that  provides  the  user  of  the  sys¬ 
tem  help  in  controlling  the  slave  system  in  completing  [12] 
a  pre-defined  contour  following  task.  For  each  controller, 
Lyapunov-based  techniques  were  used  to  prove  the  control 
development  implements  a  stable  coordinated  teleopera¬ 
tor/haptic  system  with  a  user  assist  mechanism.  When 
the  optional  velocity  field  assist  mechanism  is  disabled, 
the  analysis  proved  the  control  development  implements  a 
stable  passively  coordinated  teleoperator/haptic  system. 
Simulation  results  demonstrated  proof  of  concept  for  both 
controllers  (see  appendices  I  and  J). 
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Appendices 


A  MIF  Desired  Trajectory  Stability  Analysis 

To  prove  that  £d(t),  X d(t),  rjd  (t),  r}d  (t)  £  Too,  let  V(t)  £ 
R  denote  the  following  function 

V  =  Vi  +  V2  (68) 

where  V\  (t)  £  R  denotes  the  following  non- negative  func¬ 
tion 

Vi±±riSMTr,d  +  \\dKT\d  (69) 

where  A d(t),  T]d  ( t ) ,  Mt  and  Kt  were  introduced  in  (21). 
The  expression  given  in  (69)  can  be  lower  bounded  by  the 
auxiliary  function,  V2{x)  £  R,  which  is  defined  as  follows 

V2  =  ‘2srjdMT\d  <  V\  (70) 

where  x(t)  £  R2"  is  defined  as  follows 

*  =  [Aj  rt\T  (71) 

and  e  £  R  is  a  positive  bounding  constant  selected  ac¬ 
cording  to  the  following  inequality 

^  min  {  Am;n  {  Mt  } ,  Ami„  {  Kt  }  }  7  , 

£<  4Amax{MT}  [7Z) 

where  Amin{-}  and  Amax{-}  denote  the  minimum  and  max¬ 
imum  eigenvalue  of  a  matrix,  respectively.  From  (70)  it  is 
clear  that  V  ( t )  is  a  non-negative  function  and  bounded 
by  the  following  inequalities 

Ai  ||.t||2  <  V  (x)  <  A2 ||z||2  (73) 

where  Ai,  A2  £  R  are  positive  bounding  constants  defined 
as  follows,  provided  that  e  is  selected  according  to  (72) 


Ar  4  -min{Amin{MT},Amin{AT}}  (74) 
-2eAmax{MT} 

A2  =  —  max  {  Ainax  {  ATt^  },  Amax{  Kt  }} 

+2eA  max  {Mr}. 

To  facilitate  the  subsequent  analysis,  the  time  derivative 
of  (68)  can  be  determined  as  follows 

1/  =  ridMTf]d  +  \dKT\d  _  (75) 

+2er^dMT\d  +  2£7?jMTArf. 

After  utilizing  (21)  and  the  fact  that  rjd  (t)  =  Xd  ( t ),  the 
expression  in  (75)  can  be  written  as 

V  =  ridF-Vd  BrVd  +  2e. A d  F  -  2eXd  BTTjd 

-2£XTdKTXd  +  2erftMTrid.  (76) 


The  right-hand  side  of  (76)  can  be  upper  bounded  as  fol¬ 
lows 


V  <  ^WVdf  +  SiWFf-X^iBrjWrjJ2 

+2£k||Ad||2  +  ^||F||2]  (7 

+2eXiaax{BT}  S3  ||Ad||2  +  —  \\rjd\\2 
— 2eAmin  {Kt}  ||Ad||2  +  2eAmax  {MT}  hdf 
where  the  following  properties  were  utilized 


VTdF  <  T\\vdf  +  Si\\F\\2 
Si 

~ VdBrVd  <  -Amin{-BT}||r?d||2 

XTdF  <  S2\\Xd\\2  +  ±\\Ff 

- XdBTrid  <  Amax  {Bt}  ^3  ||Ad||2  +  —  ||r7d||2 

~XTdKTXd  <  -Xmin{KT}\\Xd\\2 
VdMrVd  <  Xmax{MT}\\rid\\2 

where  <5i,<52,<53  £  R  are  positive  bounding  constants. 
The  expression  in  (77)  can  be  rearranged  as  follows 


V  < 


(\  1  pi  1  2£Amax  {Bt}  /7o\ 

-  (Amin  {Bt }  -  - ^ -  (78J 

— 2eAmax  {Mt})  II^H2 

-2e  (Amin  {Kt}  -  «53Amax  {BT}  -  S2)  ||Ad||2 


+  (Sl  +  |)llUI 


Provided  that  e  is  selected  to  satisfy  (72)  and  61,  S2,  S3, 
Mt,  Bt,  Kt  are  selected  to  satisfy  the  following  sufficient 
conditions 

Amin  {-Bt}  >  J_  +  2gA—  iM  (79) 

Or  03 

+2£Amax  {Mt} 

Amin{-^T }  >  ^Amax  {Bt}  +  S2  (80) 

along  with  the  Assumption  1,  then  the  right-hand  side  of 
(78)  can  be  upper  bounded  as  follows 

7<_min{>7t}F  +  6 


where  (71)  and  (73)  were  utilized,  and  7a,  7fe,  e  £  R 
denote  positive  bounding  constants. 

From  (68)  -  (70),  and  (73),  and  the  fact  that  F(t)  £ 
Too,  the  expression  in  (81)  can  be  used  with  the  result 
from  [7]  to  prove  that  x  (t),  Xd  (t),  r]d  (t)  £  Coo-  By  utiliz¬ 
ing  the  fact  that  r)d  (i)  £  Tm  along  with  (20)  and  Remark 
2,  it  is  clear  that  (t),  £d  (t),  ip  (£  (t))  £  Coo •  Based  on 
(21),  and  the  fact  that  F  (t)  £  Coo  then  fid  (t)  €  Tm. 
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After  utilizing  the  above  boundedness  statements  along 
with  Remark  2  and  the  first  time  derivative  of  (20),  it  is 
clear  that  fd  (t)  £  Coo-  The  time  derivative  of  (21)  can  be 
written  as  follows 

MTVd  +  BTf]d  +  KTrid  =  F  (82) 

where  the  fact  r/d  (t)  =  A d  (t)  was  utilized.  After  utilizing 
the  fact  that  gd(t),  f]d(t)  £  Coo,  and  the  assumption 
that  Fh  (t),  Fe  (t)  £  Coo  along  with  (82),  it  is  clear  that 
i)d(t)  £  Coo ■  The  second  time  derivative  of  (20)  can  be 
written  as  follows 

Zd  =  l^([  CT  {Q  V]T)+Vd.  (83) 

After  utilizing  the  above  boundedness  statements  and  Re¬ 
mark  2  along  with  (83),  then  £d(t)  £  Coo-  The  time 
derivative  of  (82)  can  be  written  as  follows 

MTVd  +  BTfld  +  KTfjd  =  F  (84) 

After  utilizing  the  fact  that  r/d(t ),  i )d(t)  £  Coo  and  the 
assumption  that  Fh  (t),  Fe  ( t )  £  Coo,  from  (84)  it  can  be 
showed  that  fi  fit)  £  Coo-  After  taking  time  derivative 
of  (83)  and  utilizing  the  facts  that  £d(t),  ^  (t) ,  (t) , 

£d  (t) ,  V/ fit)  £  Coo ,  then  it  is  clear  that  £  d  (t)  £  Coo- 
By  utilizing  the  above  boundedness  statements  along  with 
(19),  it  is  clear  that  xd(t),  xd(t),  xd(t),  xd(t),  and 
-J'  d  if )  £  Coo  • 

B  Proof  of  Theorem  1 

Lemma  1  Let  the  auxiliary  functions  L\  ( t ),  L2  (t)  £  K. 
be  defined  as  follows 

h  =  rT  (Nd  —  Pisgn  (e2))  (85) 

L-2  =  ~ p2e2sgn(e2 ) 

where  Pi  and  P2  were  introduced  in  (3f).  Provided  that 
/31  is  selected  to  satisfy  the  following  sufficient  condition 

Pi  >  Ci  +  — ?2  (86) 

a  i 

where  <?i  and  <r2  were  introduced  in  (33),  and  ol\  was  in¬ 
troduced  in  (15),  then 

It0  (T)  dT  ^  6>i  ft0  l2  (r)  dr  <  fb2  (87) 

where  £hl,  £b2  £  K.  are  positive  constants  defined  as 

2  n 

fbi  =  Pi^2\e2i(t0)\  -e%  (t0)Nd(t0)  (88) 

i= 1 
2  n 

?h2  -  p2J2\ e2^°)i- 

i= 1 


Proof.  After  substituting  (15)  into  Li  (t)  defined  in 
(85)  and  then  integrating  in  time,  results  in  the  following 


expression 


[  Li  (r)  dr  =  «i  f  e2  (r)  [Nd  (r)  -  Pisgn  (e2  (r))]  dr 

Jin  Jto 


Jto 

f*  de2  (r) 

+  /  — 7 — -Nd  (r)  dr 
Jto  dr 

-Pi  [  de\  ^sgn(e2  (r))dr. 


After  integrating  the  second  integral  on  the  right  side  of 
(89)  by  parts  and  evaluating  the  last  integral,  the  follow¬ 
ing  expression  is  obtained 

f  L\  (r )  dr  =  an  [  eT  6vd  -  —  (90) 

Jto  Jto  \  «1  dT 

-Pisgn  (e2))  dr  +  e2  (t)  Nd  (t) 

2  n 

i= 1 

The  right-hand  side  of  (90)  can  be  upper  bounded  as  fol¬ 
lows 

ot  ft  2 n 

/  Lb  (r)  dr  <  ol\  /  D^MKIVaMI  (91) 

J  t  n  J  t  n  „•  _  i 


Pi  dr 


±  dNd.  (r) 
a  i  dr 


+  y~l  le2 i  (f)|  (|Ad.  (t) |  -  Pi)  +Cbi- 

i=l 

If  Pi  is  chosen  according  to  (39),  then  the  first  inequality 
in  (87)  can  be  proven  from  (91).  The  second  inequality 
in  (87)  can  be  obtained  by  integrating  the  expression  for 
L2(t)  defined  in  (85)  as  follows 

f  L2  (t)  da  =  -P2  j  e2  (r)  sgn  (e2  (r))  dr  (92) 

Jto  Jto 

2  n 

=  ib2  -  P2  ^  le2 i  (f)l  <  fb2-  ® 

i= 1 

The  following  is  the  proof  of  Theorem  1. 

Proof.  Let  the  auxiliary  functions  Pi  (f),  P2  (t)  £  K. 
be  defined  as  follows 

Pi  =  Ui  -  f  Li  (r)  dr  >  0  (93) 

Jto 


Pi  =  tb2  -  f  P-2  (t)  dr  >  0  (94) 

Jt0 

where  Li  ( t ),  L2  ( t ) ,  fbl  and  f,b2  were  defined  in  Lemma 
1.  The  proof  of  Lemma  1  ensures  that  Pi  (t)  and  P2  (t) 


are  non-negative.  Let  V  ( y ,  t)  £  M.  denote  the  following 
non-negative  function 

V  ~  \eie±  +  \ele2  +  ^rTMr  +  P2  +  P2  (95) 
where  y  ( t )  £  M6n+2  is  defined  as  follows 

y±[zT  ^  (96) 

where  z  ( t )  £  M6”  is  defined  as  follows 

^  =  [  ef  el  rT  f .  (97) 

Because  M  (x)  is  assumed  to  be  bounded  as  defined  in 
(14),  (95)  is  bounded  as  follows 

W1(y)<V(y,t)<W2(y)  (98) 

where  W\  (■ y ),  W2  (y)  £  K.  are  defined  as 

Wi(y)  =  Xi  || 2/(7:) || 2  W2(y)  ±  \2\\y(t)\\2  (99) 

where  Ai  =  \  min{l,mi}  and  A2  =  max {l,  \m2)  ■ 

After  differentiating  (95)  in  time,  the  following  expres¬ 
sion  can  be  obtained 

V  =  -a2elei- aiele2-rT  (ks  +  l)r  (100) 

+efe2  +  rrN  -  rT  (32sgn  (e2)  +  (32elsgn  (e2) 

where  (15),  (16),  (36),  (93),  and  (94)  were  utilized.  To 
facilitate  the  subsequent  analysis,  the  following  inequality 
can  be  developed  from  (30)  -  (32)  (see  Appendix  H) 

^(■)||<p(NI)NI  (101) 

where  p  (•)  is  a  positive,  invertible  bounding  function  that 
is  non-decreasing  in  ||z||.  By  utilizing  (15),  (101),  and  the 
triangle  inequality,  V  (t)  can  be  upper  bounded  as  follows 

V  <  -a2ej e2  -  aiel e2  -  rT  (ks  +  1)  r  (102) 
+ei'ei  +  e^e2  +  p(II^H)  ||r||  \\z\\ 

—a1elfi2 sgn  (e2) . 

After  utilizing  (97),  the  right-hand  side  of  (102)  can  be 
rearranged  as  follows 

V  <  -A3  ||z||2  +  [p(l^ll)  ||r||  ||z||  -  ks  ||r||2 

2  n 

-ailhVM  (1°3) 

i= 1 

where  A3=  minjai  —  1,  a2  —  1, 1}.  Completing  the 
squares  on  the  bracketed  term  in  (103),  yields  the  fol¬ 
lowing  expression 

^«)n|2-^En-  (104) 

'  i=  1 


Provided  a  1  and  a2  are  selected  to  be  greater  than  2 
and  ks  is  selected  according  to  the  following  sufficient 
condition 

ks  >  or  ||z||  <  p- 1  (2 y/kj^j  (105) 

then  based  on  (104)  the  following  inequality  can  be  de¬ 
veloped 

2  n 

V  <W(y)-aif32J2\^\  (106) 

i= 1 

where  W  (y)  £  K.  denotes  the  following  non-positive  func¬ 
tion 

W  {y)  =  -f30\\z\\2  (107) 

where  /30  £  K.  is  a  positive  constant.  From  (95)-(99)  and 
(104)-(107)  the  regions  D  and  S  can  be  defined  as  follows 

V  4  {y  €  M6n+2  |  | i y 1 1  <  p -1  fey/kX)  }  (108) 

S±{y£V\W2(y)<\1  (p-1  (2v/feA^))2|.  (109) 

Note  that  the  region  of  attraction  in  (109)  can  be  made 
arbitrarily  large  to  include  any  initial  conditions  by  in¬ 
creasing  the  control  gain  ks  (i.e.,  a  semi-global  stability 
result).  Specifically,  (99)  and  (109)  can  be  used  to  calcu¬ 
late  the  region  of  attraction  as  follows 

W2(y(t0))  <  \i  (p'1  (2Vhh))2  (110) 

=>  l|y(fo)||  <  (2aA’sa3) , 

which  can  be  rearranged  as 

**£^!(\/yb(‘o)l1)'  (m) 

By  utilizing  (88),  (96)  and  (97)  the  following  explicit  ex¬ 
pression  for  ||j/ (to)  ||  can  be  derived  as  follows 

l|p(fo)||2  =  ||ei  (to)||2  +  ||e2  (to)IT  (112) 

+  llr  (io)||2  +  Chi  +  Ch2- 

From  (95),  (106),  (109)-(111),  it  is  clear  that  V  ( y,t )  £ 
£ 00  My  (t0)  £  5;  hence  a  ( t ),  e2  (t),  r  (t),  z  ( t ),  y  ( t )  € 

My  (to)  £  S.  From  (106),  it  is  easy  to  show  that  e2  (t)  £  £\ 
My  (to)  £  S.  The  fact  that  e2  (t)  £  C\  My  (to)  £  S  can  be 
used  along  with  (16)  to  determine  that  ei  (t)  ,ei  (t)  £  £\ 
My  (to)  £  S.  From  (7),  (17)  and  the  fact  that  Xd  (t)  £ 
it  is  clear  that  x(t),  xm(t),  xs(t)  £  My  (to)  £  S. 
From  (15)  and  (16)  it  is  also  clear  that  e2  (t),  ei  (t)  £ 

My  (to)  £  S.  Using  these  boundedness  statements,  from 
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(35)  it  is  clear  that  u  ( t )  €  Coo  Vy  (to)  €  S.  Since 
ei  (f)  £  Coo,  from  the  second  time  derivative  of  (17),  and 
the  fact  that  xd  (i)  £  Coo  along  with  (27),  it  is  clear  that 
u(t)  £  Coo  Vy(io)  £  <$•  The  previous  boundedness  state¬ 
ments  can  be  used  along  with  (36),  (101),  and  Remark 
4  to  prove  that  r  (t)  £  Coo  Vy  (to)  £  S.  These  bounding 
statements  can  be  used  along  with  the  time  derivative  of 
(107)  to  prove  that  W  (y(t))  £  Coo  Vy  (to)  €  S;  hence, 
W  ( y  (t))  is  uniformly  continuous.  Standard  signal  chas¬ 
ing  arguments  can  be  used  to  prove  that  all  remaining 
signals  are  bounded.  A  direct  application  of  Theorem  8.4 
in  [13]  can  be  used  to  prove  that  (t)||  — ^  0  as  t  — >  oo 
Vy  (to)  €  S.  From  (97),  it  is  clear  that  ||r(t)||  — ►  0  as 
t  — ►  oo  Vy  (to)  £  S.  Based  on  the  definitions  given  in  (15) 
and  (16),  standard  linear  analysis  tools  can  be  used  to 
prove  that  if  ||r  (t)||  -*•  0  then  ||e2  (t)|| ,  ||e2  (t)|| ,  ||ei  (t)||, 
|| ei  (t)||  — ►  0  as  t  — ►  oo  Vy  (to)  £  S.  Based  on  the  defi¬ 
nition  of  x(t)  in  (7)  and  e\  (t)  in  (17),  it  is  clear  that  if 
II ei  (t)||  *-»•  0  then  xs  (t)  -*•  xm  (t)  and  xm  (t)  £ d  (t) . 


By  substituting  the  time  derivative  of  (17)  into  (117),  the 
following  expression  can  be  obtained 


/  to 


xT(T)F(r)dT  =  /  (r)  F  (r)  dr  (118) 


'to 


e[  (r)  F  (r)  dr 


/to 


where  (13), (19)  and  (22)  were  utilized.  Based  on  (116),  it 
is  clear  that  ftg  fd  (r)  F  (r)  dr  is  lower  bounded  by  —  c2. 
The  fact  that  e\  (t)  £  C\  (see  the  proof  for  Theorem  1) 
and  the  assumption  that  F  (t)  £  Coo  can  be  used  to  show 
that  the  second  integral  of  (118)  is  bounded.  Hence,  these 
facts  can  be  applied  to  (117)  and  (118)  to  prove  that 


Fh(t) 

Fe(t) 


dr  >  —  C3 


(119) 


where  c%£  K.  is  a  bounded  constant.  H 


C  Proof  of  Theorem  2 


D  Proof  of  Theorem  3 


Proof.  Since  the  user  assist  mechanism  is  disabled  (i.e. , 
7  =  0),  the  target  system  defined  in  (20)  and  (21)  can 
be  simplified  to  (25).  Let  Vp  (t)  £  R  denote  the  following 
non-negative  function 

yP  =  \iTdMTid+l-edKTu-  (ns) 

After  differentiating  (113)  in  time,  the  following  simplified 
expression  can  be  obtained 


Lemma  2  Let  the  auxiliary  functions  L\  (t),  L2  (i)  €  R 
be  defined  as  follows 

L±  =  -rT  (f  +p1sgn(e2)j  (120) 

L2  =  ~ f32elsgn(e2 ) 

where  and  /32  were  introduced  in  (61).  Provided  that 
/31  is  selected  to  satisfy  the  following  sufficient  condition 

/?i>?3  +  ?4,  (121) 


VP  =  kTdF-fdBTkd 


(114)  where  C3  and  C4  were  introduced  in  (64),  then 


where  (25)  was  utilized.  Based  on  the  fact  that  F>t  is  a 
constant  positive  definite,  diagonal  matrix,  the  following 
inequality  can  be  obtained 


<  fdF.  (115) 

Integrating  both  sides  of  (115),  results  in  the  following 
inequality 


ft  • t 

-C2  <  Vp  (t)  -  Vp  (to)  <  /  fd  (a)F(a)  da  (116) 
Jto 

where  c2  £  R.  is  a  positive  bounded  constant  (since 
Vp  (t)  is  bounded  from  the  trajectory  generation  system 
in  (25)). 

By  using  the  transformation  in  (7),  the  left-hand  side 
of  (6)  can  be  expressed  as 


ftt0L1(r)dT<fbl  f*o  L2  (t)  dr  <  fb2  (122) 
where  fbl,  f,b2  £  R  are  positive  constants  defined  as 

2  n 

Zbi  ~  Pi^2\e2i(to)\~e2  (t°)(-F(to)) 

i= 1 
2  n 

tb2  =  /32E  lea*  (*o)|  -  (123) 


Proof.  After  substituting  (44)  into  L\  (t)  defined  in 
(120)  and  then  integrating  in  time,  results  in  the  following 
expression 


f  L\  (r)  dr  =  f  e2  (r)  -  F  (r) 
Jt0  Jto 


(124) 


-/?i sgn(e2  (r))]dr 
[*  de2  (r) 


'to 


-Pi  f 

Jto 


dr 

t 


(-  F  (r)) 


dr 


de2  (r) 
dr 


sgn  (e2  (r))  dr. 
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After  integrating  the  second  integral  on  the  right-hand  where  W3  (y),  W4  (y)  £  R  are  defined  as 
side  of  (124)  by  parts  and  evaluating  the  last  integral, 

the  following  expression  is  obtained  W3  (y)  =  A4  \\y  (f)||2  W4  (y)  =  A5  \\y  (i)||2  (133) 


/  £1  (r)  dr  = 

/  el(r)( 

ho 

Jto  V 

—Pisgn  (e2  (t)))  dr  (125) 

2  n 

-el  (f)  F  ( t )  -  /?!  ^  |e2j  (t)|  +  £bl. 


The  right-hand  side  of  (125)  can  be  upper  bounded  as 
follows 


where  A4,  A5  €  R  are  positive  bounding  constants. 

After  differentiating  (130)  in  time,  results  in  the  fol¬ 
lowing  expression 

Vi  =  -el e2  -  ksrTr  -  (32el sgn  (e2)  (134) 

where  (44),  (63),  (128),  and  (129)  were  utilized.  The 
expression  in  ( 134)  can  be  rewritten  as 


ft  ft  2« 

/  L\  (r )  dr  <  /  ^  |e2i  (r)|  I  F,  (r)  (126) 

J  to  Jto  i=\ 

+  Fi  (r)  -  /?i)  d.r 

2  n 

+  y~l  |e2 i  (t)|  (  Fj  (t)  -0i)+tibi- 

i=  1 

If  (3 4  is  chosen  to  satisfy  (121),  then  the  first  inequality 
in  (122)  can  be  proven  from  (126).  The  second  inequality 
in  (122)  can  be  obtained  by  integrating  £2(f),  defined  in 
(120)  as  follows 

/  L2  (t)  da  =  -(32  /  el  (r)  sgn  (e2  (r))  dr 

Jto  Jto 

2  n 

=  &2-/?25>2i(*)|  ^^2-  (127) 

i= 1 


2  n 

Vi  =  -  ||e2||2  -  ks  ||r||2  -  p2  Y,  le2i|  ■  (135) 

i=  1 

From  (130)  and  (135),  it  is  clear  that  V4  ( y,t )  €  £00! 
hence,  e2  (t)  €  £00  n£2  n  £1,  r  (t)  £  Coo  Fl  £2,  and  y  (t)  £ 
Coo  ■  Since  e2  (t),  r(t)  £  Coo ,  then  (44)  and  (62)  can 

be  used  to  prove  that  e2  (t),  F  (t)  £  Coo ■  Given  that 

e2  (t)  P  ( t )  £  Coo  and  the  assumption  that  F  (t)  £ 
Coo,  (60)  can  be  used  to  prove  that  r(t)  £  Coo-  Barbalat’s 
Lemma  can  be  utilized  to  prove 

||e2(t)|| ,  \\r(t)\\  ■■=*  0  as  t  — ►  00.  (136) 

From  (44),  (45),  (136)  and  the  fact  that  M(x)  £  Coo, 
standard  linear  analysis  arguments  can  be  used  to  prove 
that  ei(t),  ei  (t),  e2(t)  €  Coo  and  e\{t),  e\ (t)  £  £1,  and 
that 


The  following  is  the  proof  of  Theorem  3. 

Proof.  Let  the  auxiliary  functions  P\  (t),  P2  ( t )  £  R 
be  defined  as  follows 

Pi=Ui-  /f£i(r)dr>0  (128) 

Jto 

P2=U2~  f  L2(r)dT>0  (129) 

Jto 

where  £1  (t),  L2  (f) ,  £bl  and  ^62  were  defined  in  Lemma 
2.  The  proof  of  Lemma  2  ensures  that  Pi  (t)  and  P2  (f) 
are  non-negative.  Let  V\  (y,  t)  £  R  denote  the  following 
non-negative  function 

Vi  =  7^ele2  +  ^rTr  +  P4  +  P2  (130) 

where  y  (t)  £  M4n+2  is  defined  as 

y±[el  rT  \[P\  VPi]T.  (131) 

Note  that  (130)  is  bounded  by  the  following  inequalities 

W3(y)<V1(y,t)<W4(y)  (132) 


||e1(t)|| ,  ||e1(i)|| ,  ||e2(f)||  — ►  0  as  t  -»•  00.  (137) 

By  using  the  assumption  that  F  ( t )  £  Coo  and  the  fact 
that  e2  (f)  £  Coo  from  (58)  it  is  clear  that  F  (t)  £  Coo- 
Since  F  (f )  £  Coo ,  (49)  and  the  proof  in  Appendix  F  can 
be  used  to  prove  that  Xd  (f),  gd  (t) ,  f/d  (t) ,  £d  (t) ,  £d  (t) , 
£d(t)  £  Coo-  Using  these  facts  along  with  (42),  (46)  and 
their  first  time  derivatives,  it  is  clear  that  a :(£),  x(t), 
xm(t),  Xm(t),  Xs(t),  xs(t)  £  Coo-  Since  ei  (t) ,  ex  (f) , 

M  (. x ) ,  M  (x)  £  Coo,  it  is  clear  from  (57)  that  Tf  (t)  £ 
Coo,  and  using  previously  stated  bounding  properties, 
T(t)  £  Coo-  It  is  also  possible  to  state  that  Tf  (f)  £  C 1, 
where  (57)  was  utilized.  Based  on  the  definition  of  x  (t) 
in  (42)  and  the  previously  stated  bounding  properties,  it 
is  clear  that  xs  (t)  — ►  xm  ( t )  and  xm  ( t )  — >  ^  (f) .  From 
these  bounding  statements  and  standard  signal  chasing 
arguments,  all  signals  can  be  shown  to  be  bounded.  H 

E  Proof  of  Theorem  4 

Proof.  Since  the  user  assist  mechanism  is  disabled  (i.e. , 
7  =  0),  the  target  system  defined  in  (48)  and  (49)  can  be 
simplified  to  (52).  To  assist  in  the  subsequent  analysis, 
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the  following  expression  can  be  developed  from  integra¬ 
tion  by  parts 

f  Mei  (r)  dr  =  Me\(t)  —  Mei  (to)  (138) 


M  e\  (r)  dr. 


J  to 

Since  M  (x) ,  M  (, x ) ,  ei(i)  €  Coo,  and  ei  (t)  £  A,  then 
Mei  (r)  dr  €  £<*,.  After  integrating  (55)  as  follows 

f  F  (t)  dr  =  —  j  Mei  (t)  dr  —  f  T i  (r)  dr  (139) 

t/  to  «/  to  J  to 

and  using  the  facts  that  T’i(t)  €  A  (see  proof  of  Theorem 
3)  and  that  Mei  (r)dr  €  /A,  it  is  clear  that  F(t)  € 
A,  where  F  (t)  £  R2"  is  defined  as  follows 


F=  F-  F. 


(140) 


The  expression  in  (140)  can  be  decomposed  as  F  (t)  = 
[  F I  ]T  >  where  F1  (t) ,  F2  (t)  £  R".  After  utilizing 

the  fact  that  F  (to)  =  O2 „,  the  following  can  be  derived 


F(t)  =  F  (r)  dr. 


(141) 


/to 


From  the  proof  of  Theorem  3  (see  Appendix  D),  it  is  clear 
that  F  (t)  £  Loo,  then  from  (141)  it  is  also  clear  that  F 

(t)  £  A- 

By  using  the  transformation  in  (42),  the  passivity  ob¬ 
jective  in  (6)  can  be  rewritten  as  follows 

rt  f  Fh  (r) 


[  [  (r)  xj  (r)  ] 

Jtn 


'  to 

f 

1 10 


xT  F  dr  — 


/  to 


£2 


Fe(t) 

■T 


dr  (142) 


Fdr. 


By  utilizing  (140)  and  the  time  derivative  of  (46),  (142) 
can  be  rewritten  as  follows 


rt 


rt 


/  xT  Fdr  — 

I  to  Jto  L 

rt 


0Tn  £2 


Fdr 


(143) 


rt 


I  sf  (r)  A  (r)  dr  +  /  £f  (r)  A  (r)  dr 

/to  Jto 

rt 

T  . 


-  /  e1  (r)  F  (r)  dr. 


/to 


Following  expression  can  be  developed  from  integration 
by  parts  of  the  second  integral  at  the  right-hand  side  of 
(143) 


rt  r 


xT Fdr 


1  to 


/to 


■T 


dji  £2 


Fdr 


(144) 


/  to 


£1  (t)  A  (t)  dr  -  /  (r)  A  (r)  dr 


/  to 


+£f  (t)  A  ( t )  -  /  ef  (r)  F  (r)  dr 


/to 


where  F  (to)  =  02™  is  both  utilized.  Since  A  (t)  £  Coo  and 
F(t)  £  C\,  it  is  clear  that  the  first  integral  expression  in 
(144)  is  bounded  and  a  lower  negative  bound  exists.  Since 

£i(i)€  Coo  and  F  (t)  £  C 1  it  is  clear  that  the  second  in¬ 
tegral  expression  in  (144)  is  bounded  and  a  lower  nega¬ 
tive  bound  exists,  and  since  £1  (t) ,  F  (t)  £  Coo  then  third 
expression  is  also  bounded  and  a  lower  negative  bound 
exists.  Finally,  because  ei(i)  £  A  and  F(t)  £  Coo,  it 
is  possible  to  show  that  the  last  integral  in  (144)  is  also 
bounded  and  a  lower  negative  bound  exists.  Hence,  these 
facts  can  be  applied  to  (142)  to  prove  that 


Fh(t) 

Fe(t) 


dr  >  — c2 


(145) 


where  C4£  R  is  a  bounded  constant.  H 


F  UMIF  Desired  Trajectory  Stability  Analysis 

In  the  proof  of  Theorem  3  (see  Appendix  D),  it  is  proven 

that  ei  (t) ,  62(f),  r(t),  F(t),  F  (t)  £  C^  as  well  as  that 
||ei(i)|| ,  ||e2  (i) || ,  and  ||r(f)||  — »  0  as  t  — >  00  regardless 
of  whether  or  not  x  (t) ,  £^  (t) ,  A d(t),  r]d  ( t ),  i]d  (t)  £  Coo- 
Therefore  the  fact  that  F(t)  £  Coo  can  be  used  in  the 
subsequent  analysis.  To  prove  that  A d(t),  r/d  (t)  £  Coo ,  let 
V(t)  £  R  denote  the  following  function 


V  =  Vj  +  V2  (146) 

where  Vi  (t)  £  R  denotes  the  following  non- negative  func¬ 
tion 


Vi±^MTVd  +  l*dKT\d  (147) 

where  A d(t),  r/d  (t) ,  MT  and  KT  were  introduced  in  (49). 
The  expression  given  in  (147)  can  be  lower  bounded  by 
the  auxiliary  function,  V2  (5)  €  R,  defined  as  follows 

V2  —  2eri^ Alj-Xd  <  Vi  (148) 

where  x(t)  £  R4ri  is  defined  as 

*=[Aj  vTd]T  (149) 


and  e  £  R  is  a  positive  bounding  constant  selected  ac¬ 
cording  to  the  following  inequality 


£  < 


min  {Amin  {Mr},  A 

min  {Ft}} 

4Amax{Mr} 


(150) 


where  Am;n{-}  and  Amax{-}  denote  the  minimum  and  max¬ 
imum  eigenvalue  of  a  matrix,  respectively.  From  (148)  it 
is  clear  that  V  (t)  is  a  non-negative  function  and  bounded 
by  the  following  inequalities 


Ai  ||x||2  <  V  (a:)  <  \2  ||a:||2  (151) 
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where  Ai,  A2  el  are  positive  constants  defined  as  follows, 
provided  that  s  is  selected  according  to  (150) 

Ai  =  ^min{Amin{MT},Amin{AY}}  (152) 
-2sAmax{Afr} 

A2  =  niax  { A,  1  la x  {1  //| .  Anlax  |  /t/' 1 1 

+2eA  max  {Mr}. 

To  facilitate  the  subsequent  analysis,  the  time  derivative 
of  (146)  can  be  determined  as  follows 


V  -  r)jMTi)d  +  \jKt  Xd 

+2efj^MT\d  +  ^sVd^T^d- 


(153) 


After  utilizing  (49)  and  the  fact  that  rjd  (t)  =  Ad  (t),  the 
expression  in  (153)  can  be  written  as 

V  =  {MtM  ^)  F  —  7^Bj’Tjd  +  2e\dMTM  1 F 
—2e\dBTild  —  2sAj  AYA7  +  ^VdMTVd-  (154) 

The  right-hand  side  of  (154)  can  be  upper  bounded  as 
follows 


V  <  CmA.nax  {MT} 

—  Amin  {-Bt}  \\Vd\ 

+2  s£  777,  ^  max  {Mt} 


<5i  hd\ 
2 


2  +  - 


(155) 


^3||Ad||2  +  ^ 

<?3 

|2  1 


^2  II Ad ||^  +  —  j|??d||2 


+2sAmax  {Bt} 

L 

-2eAmjn  {At}  ||Ad||2  +  2eAmax  {MT}  \\Vd\\2 
where  the  following  properties  were  utilized 


rfdMTM~1F  <  £mAmax{Mr}  ^  (156) 


1 

-VdBrrid  <  -Amin {BT}  \\Vd\\ 
2e\dMTM~1F  <  2s£rf(A max{Mr} 


^3  l|Ad|| 


£3 


(157) 

(158) 


—2eX^BTrid  <  2£Amax  {Bt}  |#2  ||Ad||  (159) 

+  6“ 

—2e\^KT\d  <  — 2eAm;n  {Ar}  ||Ad||2  (160) 

2 sr^MrVd  <  2sAmax  {Mr}  ||??J2  (161) 

where  <5i,  62, <5,3  €  R  denote  positive  bounding  constants 
and  R  denotes  positive  bounding  constant  defined 
as 


M 


-11 


<  Cm 


(162) 


where  ||  M  1 1|  denotes  the  induced  infinity  norm  of  the 
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bounded  matrix  M _1  (x) . 

The  expression  in  (155)  can  be  rearranged  as  follows 


V  < 


(Amin  {Bt}  -  i  777,^1  ^max  {Mt} 
2eAmax  { B'j 1 ) 


-  2eAmax  {Mt  A  \\Vd\\ 


2S  (Amin  {Kt}  -  82  A  max  {Bt} 
irahXmax{MT})\\Xd\\2 
1  2s 


m^'niax  {Mt}  (  ^  ^ 


+£ro^ 


(163) 

2 


Provided  <5i,  82,  83,  Mt,  Bt,  Kt  and  s  are  selected  to 
satisfy  (150)  and  the  following  sufficient  conditions 


Amin  {  Bt  } 


Amin  {A>} 


max  {Mt} 

+  2sAmax  {Bt}  +  2gAmax  {Mt} 

0  2 

>  Cm^3  A  max  {Mt}  +  ^2  A  max  {Bt} 


right-hand  side  of  (163)  can  be  upper  bounded  as  follows 


E< 


min{7a,7b}^  _ 

A2 


(164) 


where  (149)  and  (151)  were  utilized,  and  7a,  7b,  e  €  R 
denote  positive  bounding  constants. 

From  (146)  -  (148),  and  (151),  and  that  F (t)  £  Coo 
(see  Appendix  D),  the  expression  in  (164)  can  be  used 
with  the  result  from  [7]  to  prove  that  x  (f),  \d  (t),  r)d  (t)  £ 
Coo.  Based  on  (49),  and  the  fact  that  M~1  (x),  F  (t)  £ 
Coo  then  fjd  ( t )  £  Coo  ■  After  utilizing  the  fact  that  i)d  (t) , 
fid  ( t )  £  Coo  along  with  the  Remark  2,  then  it  is  clear  that 

Uif),kd{t),ld{t)^Coo.  ■ 


G  Existence  of  the  Inverse  of  M Mj,  ^ 

To  show  that  (MM^1)  1  term  introduced  at  the  right- 
hand  side  of  (49)  exists,  from  (10)  and  the  fact  that  MT  is 
a  positive  definite,  diagonal  matrix,  then  it  is  clear  that 


MM Y1  =  S~T 


M\  0nxn 

Oroxro  M2 


S-'M^1 


(165) 


where  S,  M\  (•)  and  M2  (•)  were  introduced  in  (8),  (1)  and 
(2),  respectively.  From  (165),  it  is  clear  that, 


(MAY1) 


MtS 


M1  1  0nxn 

Onxn  M2 


ST. 


(166) 
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H  Upper  Bound  Development  for  MIF  Analy-  can  be  upper  bounded  as  follows 
sis 


N 


< 


(170) 


To  simplify  the  following  derivations,  (31)  can  be  rewrit¬ 
ten  as  follows 


N  =  N  (x,x,x,ei,e2,r,x d)  (167) 

=  Mx'd+  M  i+  N  +e2 

+M  (ai  +  az)  r  -  M  (of  +  0102  +  a|)  e2 

1  - 


dN  {a1,  xd,  xd,  0,0,0,  xd) 


+ 


da  1 

dN  (x,a2,Xd,  0,0,0,  x'd) 


da2 

dN  (x,i,  <j3,0,0,0,  xd) 


+Ma \e\  +  -  M  r 


where  (15)  and  (16)  were  both  utilized.  To  facili¬ 
tate  the  subsequent  analysis,  N  (x,  id,  id,  0, 0, 0,  xd), 
N  (x,  x,  xd,  0, 0, 0,  xd),  N  (x,  x,  x,  0, 0, 0,  xd), 

N  (x,  x,  x,  ei,  0, 0,  x'd) ,  and  N  (x,  x,  x,  ei,  e2, 0,  x'd) 
are  added  and  subtracted  to  the  right-hand  side  of  (30) 
as  follows 


+ 


da3 

dN  (x,  x,  x,  <74, 0, 0,  x'd) 


da 4 

dN  (x,  x,  x,  ei,  <75, 0,  x'd ) 


+ 


da  5 

dN  (x,x,x,e1,e2,a6,xd) 


ei 


ed 


I  ei  I 


ei 


le2 1 


da6 


r  . 


The  partial  derivatives  in  (169)  can  be  calculated  by  using 
(167)  as  follows 


N  (168) 

=  [N  (x,  id,  xd,  0, 0, 0,  x'd)  -  Nd  (xd,  xd,  xd,  0, 0, 0,  xd)} 
+  [N  (x,  x,  xd,  0, 0, 0,  x'd)  -  N  (x,  xd,  id,  0, 0, 0,  xd)] 
+  [N  (x,  i,  x,  0, 0, 0,  x'd)  -  N  (x,  i,  xd,  0, 0, 0,  '£<*)] 

+  [N  (x,x,i,e i,0,0,  x'd)  -  N  (x,  x,  x,  0, 0, 0,  xd)] 

+  [N  (x,i,x,e  1,  e2, 0,  x'd)  -  N(x,i,x,e  1, 0, 0,  'i'd)} 

+  [N  (x,  x,  x,  ei,  e2,  r,  xd)  -  N  (x,  i,  x,  ei,  e2, 0,  xd)]  ■ 


After  applying  the  Mean  Value  Theorem  to  each  brack¬ 
eted  term  of  (168),  the  following  expression  can  be  ob¬ 
tained 


dN  (ai,  xd,  xd,  0,0,0,  x'd)  _  dM  (a\) . 


da  1 


N  = 


(169) 


dN(a1,xd,xd,0,0, 0,  xd) 


da\ 

dN  (x,a2,  xd,  0,0,0,  xd) 


da  2 

dN  (x,x,a3, 0,0,0,  x'd) 


da3 

dN  (x,  x,  x,  <74, 0, 0,  x’d) 


<9(74 

dN  (x,x,x,e1,a5,0,  xd) 


+ 


da  5 

dN  (x,  i,  x,  ei,  e2,  a6,  x'd) 


(x  -  xd) 
(i  ~  id) 

>2 

(x  -  id) 
(ei  -  0) 
(e2  -  0) 


dN  (x,  <72: 

o' 

0 

0 

X'd) 

da  2 

dN  (. X ,  X, 

,0-3,0, 0, 0, 

X'd ) 

da3 

dN  (x,  i, 

i,  <74, 0, 0, 

x'd ) 

9(74 

dN  (x,  i,  i,  ei,  <75, 0, 

x'd ) 

da5 

dN  (x,i,i 

,  ei,e2,ae, 

x'd ) 

—  o  a 

0(7 1 

d  M  (ai,id) .. 

H - 5 - xd 

0(7 1 

d  N  (ai,id,id) 

da  1 

d  M  (; x,a2 ) .. 

—  o 
0(7  2 

d  N  ( x,a2,id ) 
da2 

=  M  ( x,i ) 

d  N  (x,i,a3) 
da3 

=  a\M  (x) 

=  I'2n 


(171) 


(172) 

(173) 

(174) 

(175) 


dae 


—  (oi\  +  aia2  +  o|)  M  (x) 
(ai  +  a2)  M  (x)  (176) 

M  (x,i) 


da6 


(r  _  q-j  where  I“2n  €  K2nx2"  denotes  the  identity  matrix.  By 
defining 


Vi=X-  T 1  (x  -  Xd)  V2=i-  T  2  (x  -  id) 

where  vi  €  (xd,  x),  v2  e  ( id ,  i),  v3  e  [id,  x),vA&  (0,  ei),  v3  =  i  -  r3  (x  -  id)  u4  =  ei  -  r4  (ei  -  0) 

v3  e  (0,  e2),  and  v6  e  (0,  r).  The  right-hand  side  of  (169)  v5  =  e2  -  r5  (e2  -  0)  v6  =  r  -  r6  (r  -  0) 
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where  r*  €  (0,1)  Vi  =  1,2,..., 6,  and  if  the  assumptions 
stated  for  the  system  model  and  the  desired  trajectory 
are  met,  then  upper  bounds  for  the  right-hand  sides  of 
(171)-(176)  can  be  rewritten  as  follows 


dN  (ai,xd,xd,0,0,  0,  x d) 


da\ 


(Tl  = 


Vl 


^p1(x,x,x)  (177) 


dN  (x,a2,xd,0, 0,0,  x'd) 

d<72 

<J  2=V2 

<  p-2  (x,  X,  x) 


(178) 


dN  ( x,x ,  (73,0,0,0,  xd) 

<9cr3 

&  3  —V3 

<  P3  (x,  x) 


(179) 


dN  (x,  x,x,  04, 0, 0,  x'd ) 

(9(74 

(7  4=1f4 

<  Pd  (x) 


(180) 


dN  (x,x,x,ei,a5,0,  xd) 

<9(75 

<T5=V5 

dN  (x,x,x,e1,e2,a6,xd) 

da6 

CO 

? 

II 

CO 

b 

<  Pb  0*0 


<  Pe  {x,  V’) 


(181) 


(182) 


where  pi  (•)  Vi  =  1,2,. ..,6,  are  positive  nondecreasing 
functions  of  x(t),  x(t),  and  x(t).  After  substituting 
(177)-(182)  into  (170),  N  (•)  can  be  rewritten  as 

N  <  [Pi(||ei||,||e2||  ,||r||)  +  p4(||ei||)]  ||ei||  (183) 

+P2(l|ei|M|e2|M|r||)||e1|| 

+P3(l|ei|M|e2||)||e1|| 

+P5(l|ei||)  ||e2|| 

+P6(l|ei|M|e2||)||r|| 

where  (15)  and  (16)  were  utilized.  The  expressions  in 
(15),  (16)  and  (97)  can  be  used  to  rewrite  the  upper  bound 
for  the  right-hand  side  of  (183)  as  in  (101). 


I  MIF  Controller  Simulation  Results 


A  numerical  simulation  was  performed  to  demonstrate 
the  performance  of  the  MIF  controller  given  in  (26)  and 
(34).  A  2-link,  revolute  robot  dynamic  model  was  utilized 
for  both  the  master  and  slave  systems  [34]  where  AU  (•) 
and  Ni  (•)  are  defined  as  follows 


Ah 

Ni 


3.12  +  2sin(gi2)  0.75  +  sin  (qi2) 
0.75  +  sin  (qi2)  0.75 

sin  (qi2)  qi2  sin  (qi2)  (qn  +  qi2) 
—  sin  (qa)  qn  0 


(184) 

qn 

qa 


where  i  =  1  denotes  the  master  system  and  i  =  2  denotes 
the  slave  system.  By  utilizing  the  forward  kinematics  [34] , 
the  task-space  dynamic  model  is  used  in  the  simulation. 
The  task-space  user  and  environmental  input  forces  were 
set  equal  to  the  following  time-varying  signals 

— 0.18isi  —  0.3a:si 
-0.18iS2  -  0.3a;S2 

(185) 

The  target  system,  described  by  (20)  and  (21),  is  defined 
as  follows 


Fh 


—  sin  (t) 

—  cos  (t) 


=  7+  (£p)  +  Vd  (186) 


Mj1 


^ Idx 
Vdy 


=  Fh  +  Fe 


(187) 


where  Mt  =  J2  where  I2  £  K.2x2  denotes  the  identity 
matrix  and  the  terms  Bt,  and  Kt  are  selected  to  be  zero. 
The  following  planar  task-space  velocity  field  was  utilized 
[2] 


V  (O  =  ^  (Q  f  (Q  +  2c  (?p) 


(188) 


where  £p  =  [  t;py  ] T  is  the  desired  end-effector  po¬ 
sition,  and  /  (•) ,  K  (•) ,  c  (•)  €  K.  are  defined  as  follows 


/+) 

KiQ 

“fe.) 


c0  exp  ( 

r 2  ^)) 

9/(«P) 

dip 

(189) 


-1 


In  (189),  ra  =  1  [m]  denotes  the  circle  radius,  k0  =  3 
[ms-1]  ,  e  =  0.005  [m3]  ,  cQ  =  0.25  [ms-1]  ,  and  p  =  20 
[m-1]  were  selected  for  the  simulation.  For  the  sim¬ 
ulation,  the  user  assist  mechanism  is  enabled,  hence, 
7  =  1.  The  controller  gains  are  selected  as  ks  =  100, 
0i+  02  =  109)  an<l  cxi  =  ct2  =  2. 

In  Figure  1,  the  desired  end-effector  position  £  (i)  is 
presented  when  the  user  assist  mechanism  is  disabled  (i.e. , 
7  =  0)  where  the  environmental  force  vector  Fe  (t)  is  as¬ 
sumed  to  be  zero.  From  Figure  1,  it  is  clear  that  the  user 
can  create  a  circular  desired  trajectory.  For  the  remain¬ 
ing  simulation  runs,  environmental  force  vector  Fe  (t)  is 
set  to  be  a  spring-like  input  force  vector,  as  defined  in 
(185).  The  desired  end-effector  position  £p  (t) ,  when  the 
user  assist  mechanism  is  disabled  (i.e.,  7  =  0)  and  when 
the  user  assist  mechanism  is  enabled  (i.e.,  7  =  1)  are  pre¬ 
sented  Figure  2.  From  Figure  2,  it  is  clear  that  the  user 
can  not  create  a  circular  desired  trajectory  in  the  presence 
of  the  environmental  input  force.  When  the  user  assist 
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Figure  1:  The  desired  end-effector  position  £  (t)  when 
the  user  assist  mechanism  is  disabled  (i.e. ,  7  =  0)  and 
the  environmental  input  force  Fe  (t)  is  assumed  to  be 
zero 


Figure  3:  Master  System  End-Effector  Position  xm  (t) 
when  the  user  assist  mechanism  is  enabled  (i.e.,  7=1) 


Figure  2:  Desired  End-Effector  Position  £p  (t) 

mechanism  is  enabled  (i.e.,  7  =  1),  then  the  user  can  cre¬ 
ate  a  circular  desired  trajectory  even  in  the  presence  of 
environmental  force.  The  end-effector  positions  for  the 
master  and  the  slave  systems  are  given  in  Figures  3  and 
4,  respectively.  The  master  system  tracking  error  e\\  (t) 
and  coordination  error  ei2  (t)  are  presented  in  Figures  5 
and  6,  respectively.  From  Figures  5  and  6,  it  is  clear  that 
tracking  and  coordination  control  objectives  defined  in 
(4)  and  (5),  are  met.  The  control  inputs  for  the  master 
system  Tj  ( t )  and  the  slave  system  T2  (t)  are  provided  in 
Figures  7  and  8,  respectively. 


J  UMIF  Controller  Simulation  Results 

A  numerical  simulation  was  performed  for  the  UMIF  con¬ 
troller  given  in  (54)  and  (57).  The  2-link,  revolute  ro¬ 
bot  dynamic  model  introduced  in  (184)  was  utilized  for 
both  the  master  and  slave  systems.  By  utilizing  the  ex¬ 
act  model  knowledge  of  the  simulated  system,  F  (t)  in- 


Figure  4:  Slave  System  End-Effector  Position  xs  ( t )  when 
the  user  assist  mechanism  is  enabled  (i.e.,  7  =  1) 


Figure  5:  Master  System  Tracking  Error  en  (t)  when  the 
user  assist  mechanism  is  enabled  (i.e.,  7  =  1) 
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Link  1 


Figure  6:  Coordination  Error  ei2  (t)  when  the  user  assist 
mechanism  is  enabled  (i.e.,  7  =  1) 


Figure  9:  Desired  End-Effector  Position  £dlp  (t) 


troduced  in  (13)  is  defined  as  follows 


F  =  MM~l 


Fh  +  Fe 
-Fe 


(190) 


Figure  7:  Control  Input  for  Master  System  T\  (t)  when 
the  user  assist  mechanism  is  enabled  (i.e.,  7=1) 


Link  1 


where  Fh  (t)  and  Fe  (f)  were  defined  in  (185).  The  pla¬ 
nar  task-space  velocity  field  defined  in  (188)  was  utilized 
with  the  same  parameters.  The  constants  for  the  target 
system,  described  by  (49),  are  set  to  MT  =  J4,  where 
I4  £  M4x4  denotes  the  identity  matrix  and  the  terms  Bt 
and  Kt  are  selected  to  be  zero.  The  controller  gains  are 
selected  as  ks  =  100,  /34  +  (32  =  100,  and  a  =  1. 

The  desired  end-effector  position  £lp  (t) ,  when  the  user 
assist  mechanism  is  disabled  (i.e.,  7  =  0)  and  when  the 
user  assist  mechanism  is  enabled  (i.e.,  7  =  1)  are  pre¬ 
sented  Figure  9.  From  Figure  9,  it  is  clear  that  the 
proposed  user  assist  mechanism  provides  a  major  im¬ 
provement  to  the  desired  end-effector  position.  The  end- 
effector  positions  for  the  master  and  the  slave  systems 
are  given  in  Figures  10  and  11,  respectively.  The  master 
system  tracking  error  en  (t)  and  the  coordination  error 
ei2  (t)  are  presented  in  Figures  12  and  13,  respectively. 
From  Figures  12  and  13,  it  is  clear  that  tracking  and  co¬ 
ordination  control  objectives  defined  in  (40)  and  (41),  are 
met.  The  control  inputs  for  the  master  system  T\  (t)  and 
the  slave  system  To  (t)  are  provided  in  Figures  14  and  15, 
respectively.  The  output  of  the  nonlinear  force  observer 
F  (t)  is  presented  in  Figure  16. 


Figure  8:  Control  Input  for  Slave  System  T2  (t)  when  the 
user  assist  mechanism  is  enabled  (i.e.,  7  =  1) 


19 


Figure  10:  Master  System  End-Effector  Position  xm  (t)  Figure  13:  Coordination  Error  e\2  (t)  when  the  user  assist 
when  the  user  assist  mechanism  is  enabled  (i.e. ,  7  =  1)  mechanism  is  enabled  (i.e. ,  7=1) 


Figure  11:  Slave  System  End-Effector  Position  xs  ( t )  Figure  14:  Torque  Input  for  Master  System  T\  (t)  when 
when  the  user  assist  mechanism  is  enabled  (i.e.,  7  =  1)  the  user  assist  mechanism  is  enabled  (i.e.,  7  =  1) 


Figure  12:  Master  System  Tracking  Error  e\\  (t)  when  Figure  15:  Torque  Input  for  Slave  System  T-2  ( t )  when  the 
the  user  assist  mechanism  is  enabled  (i.e.,  7=1)  user  assist  mechanism  is  enabled  (i.e.,  7=1) 
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Fhat,(t) 


Figure  16:  The  Output  of  the  Nonlinear  Force  Observer 
F  (t)  when  the  user  assist  mechanism  is  enabled  (i.e.,  7  = 

1)  ' 
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